Abstract:In the development of autonomous driving technology, safety is always regarded as a top priority. The behavior decision-making and motion planning systems, as key components of the technology, possess higher requirements for intelligence. They need continuously make optimal strategies and behaviors according to the changing environment to ensure the safety of vehicle driving. The behavior decision-making and motion planning systems are expounded. Firstly, the theory and applications of rule-based decision algorithms, supervised learning-based decision algorithms, and reinforcement learning-based decision algorithms are introduced. Then, sampling-based planning algorithms, graph search-based planning algorithms, numerical optimization-based planning algorithms and interaction-based planning algorithms in motion planning are discussed and their designs are discussed. Behavior decision-making and motion planning are analyzed from the perspective of safety, and the advantages and disadvantages of various methods are compared. Finally, future research directions and challenges for safety in the field of autonomous driving are predicted.
[1] ORT T, PAULL L, RUS D. Autonomous Vehicle Navigation in Rural Environments Without Detailed Prior Maps // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2018: 2040-2047. [2] GEORGE L, BUHET T, WIRBEL E, et al. Imitation Learning for End to End Vehicle Longitudinal Control with Forward Camera[C/OL].[2023-01-12]. https://arxiv.org/pdf/1812.05841.pdf. [3] WANG P, CHAN C Y, DE LA FORTELLE A. A Reinforcement Learning Based Approach for Automated Lane Change Maneuvers // Proc of the IEEE Intelligent Vehicles Symposium. Washington, USA: IEEE, 2018: 1379-1384. [4] 朱威,欧全林,洪力栋,等.基于图像序列的车道线并行检测网络.模式识别与人工智能, 2021, 34(5): 434-445. (ZHU W, OU Q L, HONG L D, et al. Parallel Lane Line Detection Network Based on Image Sequence. Pattern Recognition and Artificial Intelligence, 2021, 34(5): 434-445.) [5] BAI M, MATTYUS G, HOMAYOUNYOUNFAR N, et al. Deep Multi-sensor Lane Detection // Proc of the IEEE/RSJ International Conference on Intelligent Robots and Systems. Washington, USA: IEEE, 2018: 3102-3109. [6] YE Y Y, HAO X L, CHEN H J. Lane Detection Method Based on Lane Structural Analysis and CNNs. IET Intelligent Transport Systems, 2018, 12(6): 513-520. [7] SONG W J, YANG Y, FU M Y, et al. Lane Detection and Classification for Forward Collision Warning System Based on Stereo Vision. IEEE Sensors Journal, 2018, 18(12): 5151-5163. [8] TAYARA H, SOO K G, CHONG K T. Vehicle Detection and Counting in High-Resolution Aerial Images Using Convolutional Regression Neural Network. IEEE Access, 2018, 6: 2220-2230. [9] CHEN X Z, KUNDU K, ZHANG Z Y, et al. Monocular 3D Object Detection for Autonomous Driving // Proc of the IEEE Conference on Computer Vision and Pattern Recognition. Washington, USA: IEEE, 2016: 2147-2156. [10] RAJARAM R N, OHN-BAR E, TRIVEDI M M. RefineNet: Refining Object Detectors for Autonomous Driving. IEEE Transactions on Intelligent Vehicles, 2016, 1(4): 358-368. [11] OUYANG W L, ZHOU H, LI H S, et al. Jointly Learning Deep Features, Deformable Parts, Occlusion and Classification for Pedestrian Detection. IEEE Transactions on Pattern Analysis and Machine Intelligence, 2018, 40(8): 1874-1887. [12] CAI Z W, SABERIAN M, VASCONCELOS N. Learning Comple-xity-Aware Cascades for Pedestrian Detection. IEEE Transactions on Pattern Analysis and Machine Intelligence, 2020, 42(9): 2195-2211. [13] WANG S G, CHENG J, LIU H J, et al. Pedestrian Detection via Body Part Semantic and Contextual Information with DNN. IEEE Transactions on Multimedia, 2018, 20(11): 3148-3159. [14] ZHU Z, TIAN Y, WANG X Y, et al. Fusion Predictive Control Based on Uncertain Algorithm for PMSM of Brake-by-Wire System. IEEE Transactions on Transportation Electrification, 2021, 7(4): 2645-2657. [15] ERLIEN S M, FUJITA S, GERDES J C. Shared Steering Control Using Safe Envelopes for Obstacle Avoidance and Vehicle Stability. IEEE Transactions on Intelligent Transportation Systems, 2016, 17(2): 441-451. [16] MONTEMERLO M, BECKER J, BHAT S, et al. Junior: The Stanford Entry in the Urban Challenge. Journal of Field Robotics, 2008, 25(9): 569-597. [17] BACHA A, BAUMAN C, FARUQUE R, et al. Odin: Team VictorTango's Entry in the DARPA Urban Challenge. Journal of Field Robotics, 2008, 25(8): 467-492. [18] JIAN Z Q, CHEN S T, ZHANG S Y, et al. Multi-Model-Based Local Path Planning Methodology for Autonomous Driving: An Integrated Framework. IEEE Transactions on Intelligent Transportation Systems, 2022, 23(5): 4187-4200. [19] WANG M Y, MEHR N, GAIDON A, et al. Game-Theoretic Pla-nning for Risk-Aware Interactive Agents // Proc of the IEEE/RSJ International Conference on Intelligent Robots and Systems. Wa-shington, USA: IEEE, 2020: 6998-7005. [20] WANG M Y, WANG Z J, TALBOT J, et al. Game-Theoretic Planning for Self-Driving Cars in Multivehicle Competitive Scena-rios. IEEE Transactions on Robotics, 2021, 37(4): 1313-1325. [21] BAI H Y, CAI S J, YE N, et al. Intention-Aware Online POMDP Planning for Autonomous Driving in a Crowd // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2015: 454-460. [22] CUNNINGHAM A G, GALCERAN E, MEHTA D, et al. MPDM: Multi-policy Decision-Making from Autonomous Driving to Social Robot Navigation // WASCHL H, KOLMANOVSKY I, WILLEMS F, eds. Control Strategies for Advanced Driver Assistance Systems and Autonomous Driving Functions: Development, Testing and Verification. Berlin, Germany: Springer, 2019: 201-223. [23] GALCERAN E, CUNNINGHAM A G, EUSTICE R M, et al. Multipolicy Decision-Making for Autonomous Driving via Changepoint-Based Behavior Prediction. Robotics: Science and Systems, 2015, 1(2). DOI: 10.15607/RSS.2015.XI.043. [24] ZHANG L, DING W C, CHEN J, et al. Efficient Uncertainty-Aware Decision-Making for Automated Driving Using Guided Branching // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2020: 3291-3297. [25] BORRELLI F, FALCONE P, KEVICZKY T, et al. MPC-Based Approach to Active Steering for Autonomous Vehicle Systems. International Journal of Vehicle Autonomous Systems, 2005, 3(2/3/4): 265-291. [26] FALCONE P, BORRELLI F, ASGARI J, et al. Predictive Active Steering Control for Autonomous Vehicle Systems. IEEE Transactions on Control Systems Technology, 2007, 15(3): 566-580. [27] DAI Y J, LI X H, SUN Z P, et al. Optimization-Based Interactive Speed Planning of Autonomous Vehicles in Structured Environments // Proc of the 3rd International Conference on Unmanned Systems. Washington, USA: IEEE, 2020: 714-720. [28] BOJARSKI M, DEL TESTA D, DWORAKOWSKI D, et al. End to End Learning for Self-Driving Cars[C/OL].[2023-01-12]. https://arxiv.org/pdf/1604.07316.pdf. [29] CODEVILLA F, MÜLLER M, LÓPEZ A, et al. End-to-End Dri-ving via Conditional Imitation Learning // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2018: 4693-4700. [30] WANG R H, ŚCIBIOR A, WOOD F.Safer End-to-End Autonomous Driving via Conditional Imitation Learning and Command Augmentation[C/OL]. [2023-01-12].https://arxiv.org/pdf/1909.09721v1.pdf. [31] ZENG W Y, LUO W J, SUO S, et al. End-to-End Interpretable Neural Motion Planner // Proc of the IEEE/CVF Conference on Computer Vision and Pattern Recognition. Washington, USA: IEEE, 2019: 8652-8661. [32] XU H R, ZHAN X Y, ZHU X Y. Constraints Penalized Q-Lear-ning for Safe Offline Reinforcement Learning. Proceedings of the AAAI Conference on Artificial Intelligence, 2022, 36(8): 8753-8760. [33] DJONIN D V, KRISHNAMURTHY V. MIMO Transmission Control in Fading Channels-A Constrained Markov Decision Process Formulation with Monotone Randomized Policies. IEEE Transactions on Signal Processing, 2007, 55(10): 5069-5083. [34] ACHIAM J, HELD D, TAMAR A, et al. Constrained Policy Optimization // Proc of the 34th International Conference on Machine Learning. San Diego, USA: JMLR, 2017: 22-31. [35] TESSLER C, MANKOWITZ D J, MANNOR S.Reward Constrai-ned Policy Optimization[C/OL]. [2023-01-12].https://arxiv.org/pdf/1805.11074.pdf. [36] CUI L L, OZBAY K, JIANG Z P. Combined Longitudinal and La-teral Control of Autonomous Vehicles Based on Reinforcement Learning // Proc of the American Control Conference. Washington, USA: IEEE, 2021: 1929-1934. [37] XU J, PEI X F, LÜ K X. Decision-Making for Complex Scenario Using Safe Reinforcement Learning // Proc of the 4th CAA International Conference on Vehicular Control and Intelligence. Washington, USA: IEEE, 2020: 1-6. [38] 代珊珊,刘全.基于动作约束深度强化学习的安全自动驾驶方法.计算机科学, 2021, 48(9): 235-243. (DAI S S, LIU Q. Action Constrained Deep Reinforcement Lear-ning Based Safe Automatic Driving Method. Computer Science, 2021, 48(9): 235-243.) [39] WU J D, HUANG W H, DE BOER N, et al. Safe Decision-Ma-king for Lane-Change of Autonomous Vehicles via Human Demonstration-Aided Reinforcement Learning // Proc of the IEEE 25th International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2022: 1228-1233. [40] ZHANG Y X, LIANG X L, GE S S, et al. Barrier Lyapunov Function-Based Safe Reinforcement Learning Algorithm for Autonomous Vehicles with System Uncertainty // Proc of the 21st International Conference on Control, Automation and Systems. Washington, USA: IEEE, 2021: 1592-1598. [41] LU X Z, XIAO L, NIU G H, et al. Safe Exploration in Wireless Security: A Safe Reinforcement Learning Algorithm with Hierarchical Structure. IEEE Transactions on Information Forensics and Security, 2022, 17: 732-743. [42] MO S J, PEI X F, WU C X. Safe Reinforcement Learning for Autonomous Vehicle Using Monte Carlo Tree Search. IEEE Transactions on Intelligent Transportation Systems, 2022, 23(7): 6766-6773. [43] YANG C C, LIU J, SUN H Y, et al. Safe Reinforcement Learning for CPSs via Formal Modeling and Verification // Proc of the International Joint Conference on Neural Networks. Washington, USA: IEEE, 2021. DOI: 10.1109/IJCNN52387.2021.9533979. [44] KRASOWSKI H, ZHANG Y Q, ALTHOFF M. Safe Reinforcement Learning for Urban Driving Using Invariably Safe Braking Sets // Proc of the IEEE 25th International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2022: 2407-2414. [45] KONG Q, ZHANG L L, XU X. Constrained Policy Optimization Algorithm for Autonomous Driving via Reinforcement Learning // Proc of the 6th International Conference on Image, Vision and Computing. Washington, USA: IEEE, 2021: 378-383. [46] CAI P D, WANG H L, SUN Y X, et al. DQ-GAT: Towards Safe and Efficient Autonomous Driving with Deep Q-Learning and Graph Attention Networks. IEEE Transactions on Intelligent Transportation Systems, 2022, 23(11): 21102-21112. [47] JARITZ M, DE CHARETTE R, TOROMANOFF M, et al. End-to-End Race Driving with Deep Reinforcement Learning // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2018: 2070-2075. [48] LI J N, SUN L T, CHEN J Y, et al. A Safe Hierarchical Planning Framework for Complex Driving Scenarios Based on Reinforcement Learning // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2021: 2660-2666. [49] MA Y J, SHEN A, BASTANI O, et al. Conservative and Adaptive Penalty for Model-Based Safe Reinforcement Learning. Proceedings of the AAAI Conference on Artificial Intelligence, 2022, 36(5): 5404-5412. [50] MIRCHEVSKA B, PEK C, WERLING M, et al. High-Level Decision Making for Safe and Reasonable Autonomous Lane Changing Using Reinforcement Learning // Proc of the 21st International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2018: 2156-2162. [51] KRASOWSKI H, WANG X, ALTHOFF M. Safe Reinforcement Learning for Autonomous Lane Changing Using Set-Based Prediction // Proc of the IEEE 23rd International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2020. DOI: 10.1109/ITSC45102.2020.9294259. [52] WANG J K, WANG Y, ZHANG D K, et al. Learning Hierarchical Behavior and Motion Planning for Autonomous Driving // Proc of the IEEE/RSJ International Conference on Intelligent Robots and Systems. Washington, USA: IEEE, 2020: 2235-2242. [53] WANG Z T, ZHUANG Y Z, GU Q, et al. Reinforcement Learning Based Negotiation-Aware Motion Planning of Autonomous Vehicles // Proc of the IEEE/RSJ International Conference on Intelligent Robots and Systems. Washington, USA: IEEE, 2021: 4532-4537. [54] KAMENEV A, WANG L R, BOHAN O B, et al. PredictionNet: Real-Time Joint Probabilistic Traffic Prediction for Planning, Control, and Simulation // Proc of the International Conference on Robotics and Automation. Washington, USA: IEEE, 2022: 8936-8942. [55] GONZÁLEZ D, PÉREZ J, MILANÉS V, et al. A Review of Motion Planning Techniques for Automated Vehicles. IEEE Transactions on Intelligent Transportation Systems, 2016, 17(4): 1135-1145. [56] KAVRAKI L E, SVESTKA P, LATOMBE J C, et al. Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces. IEEE Transactions on Robotics and Automation, 1996, 12(4): 566-580. [57] AMATO N M, BAYAZIT O B, DALE L K, et al. OBPRM: An Obstacle-Based PRM for 3D Workspaces // Proc of the 3rd Workshop on the Algorithmic Foundations of Robotics. New York, USA: ACM, 1998: 155-168. [58] HSU D, SUN Z. Adaptively Combining Multiple Sampling Stra-tegies for Probabilistic Roadmap Planning // Proc of the IEEE Conference on Robotics, Automation and Mechatronics. Washington, USA: IEEE, 2004: 774-779. [59] LAVALLE S M.Rapidly-Exploring Random Trees: A New Tool for Path Planning[J/OL]. [2023-01-12].https://cs.brown.edu/courses/cs1951r/assignments/motionplanning/rrtpaper.pdf. [60] HESSE T, HESS D, SATTEL T. Motion Planning for Passenger Vehicles-Force Field Trajectory Optimization for Automated Driving // Proc of the 15th IASTED International Conference on Robotics and Applications. New York, USA: ACM, 2010. DOI: 10.2316/p.2010.706-066. [61] MA Y C, LIM K G, TAN M K, et al. A Safe Overtaking Control Scheme for Autonomous Vehicles Using Rapid-Exploration Random Tree // Proc of the IEEE International Conference on Artificial Intelligence in Engineering and Technology. Washington, USA: IEEE, 2022. DOI: 10.1109/IICAIET55139.2022.9936834. [62] ALESIANI F, WUTHISHUWONG C. Locally Growing Rapid Tree (LGRT) Motion Planning for Autonomous Driving // Proc of the IEEE 19th International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2016: 1120-1125. [63] SMIT R, VAN DER PLOEG C, TEERHUIS A, et al. Informed Sampling-Based Trajectory Planner for Automated Driving in Dynamic Urban Environments // Proc of the IEEE 25th International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2022: 1690-1697. [64] MISSURA M, BENNEWITZ M. Predictive Collision Avoidance for the Dynamic Window Approach // Proc of the International Confe-rence on Robotics and Automation. Washington, USA: IEEE, 2019: 8620-8626. [65] GEHRIG S K, STEIN F J. Collision Avoidance for Vehicle-Following Systems. IEEE Transactions on Intelligent Transportation Systems, 2007, 8(2): 233-244. [66] FOX D, BURGARD W, THRUN S. The Dynamic Window Approach to Collision Avoidance. IEEE Robotics and Automation Magazine, 1997, 4(1): 23-33. [67] BROCK O, KHATIB O. High-Speed Navigation Using the Global Dynamic Window Approach // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 1999: 341-346. [68] KUAN D, ZAMISKA J, BROOKS R. Natural Decomposition of Free Space for Path Planning // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 1985: 168-173. [69] LIU C, LEE S, VARNHAGEN S, et al. Path Planning for Autonomous Vehicles Using Model Predictive Control // Proc of the IEEE Intelligent Vehicles Symposium. Washington, USA: IEEE, 2017: 174-179. [70] NILSSON J, FREDRIKSSON J, COELINGH E. Trajectory Pla-nning with Miscellaneous Safety Critical Zones. IFAC-PapersOnLine, 2017, 50(1): 9083-9088. [71] CLAUSSMANN L, CARVALHO A, SCHILDBACH G. A Path Planner for Autonomous Driving on Highways Using a Human Mi-micry Approach with Binary Decision Diagrams // Proc of the European Control Conference. Washington, USA: IEEE, 2015: 2976-2982. [72] MOUHAGIR H, TALJ R, CHERFAOUI V, et al. Integrating Safety Distances with Trajectory Planning by Modifying the Occupancy Grid for Autonomous Vehicle Navigation // Proc of the IEEE 19th International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2016: 1114-1119. [73] HUBMANN C, AEBERHARD M, STILLER C. A Generic Driving Strategy for Urban Environments // Proc of the IEEE 19th International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2016: 1010-1016. [74] AJANOVIC Z, LACEVIC B, SHYROKAU B, et al. Search-Based Optimal Motion Planning for Automated Driving // Proc of the IEEE/RSJ International Conference on Intelligent Robots and Systems. Washington, USA: IEEE, 2018: 4523-4530. [75] LI Q Q, ZENG Z, YANG B S, et al. Hierarchical Route Planning Based on Taxi GPS-Trajectories // Proc of the 17th International Conference on Geoinformatics. Washington, USA: IEEE, 2009. DOI: 10.1109/GEOINFORMATICS.2009.5293532. [76] KORF R E. Depth-First Iterative-Deepening: An Optimal Admissible Tree Search. Artificial intelligence, 1985, 27(1): 97-109. [77] STENTZ A. The Focussed D* Algorithm for Real-Time Replanning // Proc of the 14th International Joint Conference on Artificial Intelligence. San Francisco, USA: IJCAI, 1995, II: 1652-1659. [78] DOLGOV D, THRUN S, MONTEMERLO M, et al. Practical Sear-ch Techniques in Path Planning for Autonomous Driving // Proc of the 1st International Symposium on Search Techniques in Artificial Intelligence and Robotics. Palo Alto, USA: AAAI Press, 2008: 32-37. [79] FERGUSON D, HOWARD T M, LIKHACHEV M. Motion Pla-nning in Urban Environments // BUEHLER M, IAGNEMMA K, SINGH S, eds. The DARPA Urban Challenge. Berlin, Germany: Springer, 2009: 61-89. [80] CHATILA R. Path Planning and Environment Learning in a Mobile Robot System // Proc of the 5th European Conference on Artificial Intelligence. Berlin, Germany: Springer, 1982: 211-215. [81] TEHRANI H, DO Q H, EGAWA M, et al. General Behavior and Motion Model for Automated Lane Change // Proc of the IEEE Intelligent Vehicles Symposium. Washington, USA: IEEE, 2015: 1154-1159. [82] YU C L, CHERFAOUI V, BONNIFAIT P. Semantic Evidential Lane Grids with Prior Maps for Autonomous Navigation // Proc of the IEEE 19th International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2016: 1875-1881. [83] MORAS J, CHERFAOUI V, BONNIFAIT P. Credibilist Occupa-ncy Grids for Vehicle Perception in Dynamic Environments // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2011: 84-89. [84] SONG X L, CAO H T, HUANG J. Vehicle Path Planning in Various Driving Situations Based on the Elastic Band Theory for Highway Collision Avoidance. Proceeding of the Institution of Mechanical Engineers, Part D(Journal of Automobile Engineering), 2013, 227(12): 1706-1722. [85] CHOI J. Kinodynamic Motion Planning for Autonomous Vehicles. International Journal of Advanced Robotic Systems, 2014, 11. DOI: 10.5772/58683. [86] FIORINI P, SHILLER Z. Motion Planning in Dynamic Environments Using Velocity Obstacles. The International Journal of Robotics Research, 1998, 17(7): 760-772. [87] BENDER P, TAŞÖ Ş, ZIEGLER J, et al. The Combinatorial Aspect of Motion Planning: Maneuver Variants in Structured Environ-ments // Proc of the IEEE Intelligent Vehicles Symposium. Washing-ton, USA: IEEE, 2015: 1386-1392. [88] ALTCHÉ F, DE LA FORTELLE A. Partitioning of the Free Space-Time for On-Road Navigation of Autonomous Ground Vehicles // Proc of the IEEE 56th Annual Conference on Decision and Control. Washington, USA: IEEE, 2017: 2126-2133. [89] SPEIDEL O, RUOF J, DIETMAYER K. Graph-Based Motion Planning for Automated Vehicles Using Multi-model Branching and Admissible Heuristics // Proc of the IEEE International Confe-rence on Autonomous Systems. Washington, USA: IEEE, 2021. DOI: 10.1109/ICAS49788.2021.9551185. [90] AURENHAMMER F. Voronoi Diagrams-A Survey of a Fundamen-tal Geometric Data Structure. ACM Computing Surveys, 1991, 23(3): 345-405. [91] SUGIHARA K. Approximation of Generalized Voronoi Diagrams by Ordinary Voronoi Diagrams. CVGIP: Graphical Models and Image Processing, 1993, 55(6): 522-531. [92] OK K, ANSARI S, GALLAGHER B, et al. Path Planning with Uncertainty: Voronoi Uncertainty Fields // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2013: 4596-4601. [93] QUINLAN S, KHATIB O. Elastic Bands: Connecting Path Pla-nning and Control // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 1993: 802-807. [94] ZHU Z J, SCHMERLING E, PAVONE M. A Convex Optimization Approach to Smooth Trajectories for Motion Planning with Car-Like Robots // Proc of the 54th IEEE Conference on Decision and Control. Washington, USA: IEEE, 2015: 835-842. [95] ERLIEN S M, FUJITA S, GERDES J C. Safe Driving Envelopes for Shared Control of Ground Vehicles. IFAC Proceedings Vo-lumes, 2013, 46(21): 831-836. [96] PARK J, KIM D, KIM G C, et al. Online Distributed Trajectory Planning for Quadrotor Swarm with Feasibility Guarantee Using Li-near Safe Corridor. IEEE Robotics and Automation Letters, 2022, 7(2): 4869-4876. [97] LIU C L, LIN C Y, TOMIZUKA M. The Convex Feasible Set Algorithm for Real Time Optimization in Motion Planning. SIAM Journal on Control and optimization, 2018, 56(4): 2712-2733. [98] LI H, YU G Z, ZHOU B, et al. Semantic-Level Maneuver Sampling and Trajectory Planning for On-Road Autonomous Driving in Dynamic Scenarios. IEEE Transactions on Vehicular Technology, 2021, 70(2): 1122-1134. [99] DING W C, ZHANG L, CHEN J, et al. Safe Trajectory Generation for Complex Urban Environments Using Spatio-Temporal Semantic Corridor. IEEE Robotics and Automation Letters, 2019, 4(3): 2997-3004. [100] TOUMIEH C, LAMBERT A. Decentralized Multi-agent Planning Using Model Predictive Control and Time-Aware Safe Corridors. IEEE Robotics and Automation Letters, 2022, 7(4): 11110-11117. [101] CEN H J, LI B, ACARMAN T, et al. Optimization-Based Maneuver Planning for a Tractor-Trailer Vehicle in Complex Environments Using Safe Travel Corridors // Proc of the IEEE Intelligent Vehicles Symposium. Washington, USA: IEEE, 2021: 974-979. [102] ZHU H, ALONSO-MORA J. Chance-Constrained Collision Avoi-dance for MAVs in Dynamic Environments. IEEE Robotics and Automation Letters, 2019, 4(2): 776-783. [103] MILLER C, PEK C, ALTHOFF M. Efficient Mixed-Integer Programming for Longitudinal and Lateral Motion Planning of Autonomous Vehicles // Proc of the IEEE Intelligent Vehicles Symposium. Washington, USA: IEEE, 2018: 1954-1961. [104] KELLER M, HOFFMANN F, HASS C, et al. Planning of Optimal Collision Avoidance Trajectories with Timed Elastic Bands. IFAC Proceedings Volumes, 2014, 47(3): 9822-9827. [105] ALTCHÉ F, POLACK P, DE LA FORTELLE A. High-Speed Trajectory Planning for Autonomous Vehicles Using a Simple Dynamic Model // Proc of the IEEE 20th International Conference on Intelligent Transportation Systems. Washington, USA: IEEE, 2017. DOI: 10.1109/ITSC.2017.8317632. [106] LEFÈVRE S, CARVALHO A, BORRELLI F. A Learning-Based Framework for Velocity Control in Autonomous Driving. IEEE Transactions on Automation Science and Engineering, 2016, 13(1): 32-42. [107] CARDOSO V, OLIVEIRA J, TEIXEIRA T, et al. A Model-Predictive Motion Planner for the IARA Autonomous Car // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2017: 225-230. [108] BROWN M, GERDES J C. Coordinating Tire Forces to Avoid Obstacles Using Nonlinear Model Predictive Control. IEEE Tran-sactions on Intelligent Vehicles, 2020, 5(1): 21-31. [109] NG J, BRÄUNL T. Performance Comparison of Bug Navigation Algorithms. Journal of Intelligent and Robotic Systems, 2007, 50(1): 73-84. [110] YUFKA A, PARLAKTUNA O. Performance Comparison of BUG's Algorithms for Mobile Robots // Proc of the 5th International Advanced Technologies Symposium. Berlin, Germany: Springer, 2009. DOI: 10.13140/RG.2.1.2043.7920. [111] TAYLOR K, LAVALLE S M. I-Bug: An Intensity-Based Bug Algorithm // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2009: 3981-3986. [112] KHATIB O, LE MAITRE J F. Dynamic Control of Manipulators Operating in a Complex Environment[C/OL].[2023-01-12]. https://cs.stanford.edu/groups/manips/publications/pdfs/Khatib_1978.pdf. [113] KHATIB O. Real-Time Obstacle Avoidance for Manipulators and Mobile Robots // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 1985: 500-505. [114] WOLF M T, BURDICK J W. Artificial Potential Functions for Highway Driving with Collision Avoidance // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2008: 3731-3736. [115] BOUNINI F, GINGRAS D, POLLART H, et al. Modified Artificial Potential Field Method for Online Path Planning Applications // Proc of the IEEE Intelligent Vehicles Symposium. Washington, USA: IEEE, 2017: 180-185. [116] ULRICH I, BORENSTEIN J. VFH*: Local Obstacle Avoidance with Look-Ahead Verification // Proc of the IEEE International Conference on Robotics and Automation. Washington, USA: IEEE, 2000: 2505-2511. [117] CHEN W Q, WANG N, LIU X F, et al. VFH Based Local Path Planning for Mobile Robot // Proc of the 2nd China Symposium on Cognitive Computing and Hybrid Intelligence. Washington, USA: IEEE, 2019: 18-23. [118] QU P R, XUE J R, MA L, et al. A Constrained VFH Algorithm for Motion Planning of Autonomous Vehicles // Proc of the IEEE Intelligent Vehicles Symposium. Washington, USA: IEEE, 2015: 700-705.